#include "ReadIMU.h"
#include <iostream>
#include <string>
#include <time.h>
#include <sstream>

ReadIMU imu;

int main(int argc, char* argv[])
{


	int port_fd = imu.init_serial_input(USB_SERIAL_PORT);

	if (port_fd == -1)  {
		std::cout << "Couldn't open USB port" << std::endl;
	}
	while(1){
		//std::cout<<imu.readLeftHand(port_fd)<<std::endl;
		imu.read_serial_xyz(port_fd);
		imu.printValues();

	}

}
